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1  Introduction 

Integrated  simulation  capabilities  that  are  high-fidelity,  fast,  and  have  scalable  architecture  are  essential  to  support 
autonomous  vehicle  design  and  performance  assessment  for  the  U.S.  Army’s  growing  use  of  unmanned  ground 
vehicles  (UGVs).  With  increased  onboard  autonomy,  advanced  vehicle  models  are  needed  to  analyze  and  optimize 
control  design  and  sensor  packages  over  a  range  of  urban  and  off-road  scenarios.  Recent  work  at  US  Army  TARDEC 
has  attempted  to  develop  a  high-fidelity  mobility  simulation  of  an  autonomous  vehicle  in  an  off-road  scenario  using 
integrated  sensor,  controller,  and  multi-body  dynamics  models  [1].  The  conclusion  was  that  (a)  real-time  simulation 
was  not  feasible  due  to  the  complexity  of  the  intervening  formulation,  (b)  models  had  to  be  simplified  to  speed  up  the 
simulation,  (c)  interfacing  the  sensors  was  exceedingly  difficult  due  to  co-simulation,  (d)  the  controls  developed  were 
very  basic  and  could  not  be  optimized,  and  (e)  a  rigid  terrain  model  was  used. 

The  research  described  in  this  paper  is  from  a  collaborative  project  between  US  Army  TARDEC  and  NASA  Jet 
Propulsion  Laboratory  (JPL)  to  develop  an  advanced  UGV  mobility  testbed  using  JPL’s  ROAMS  vehicle  modeling  ca¬ 
pability  [2]  and  to  address  the  aforementioned  issues  in  meeting  the  US  Army’s  UGV  modeling  and  simulation  needs. 
The  ROAMS  ground  vehicle  simulation  framework  can  support  tasks  ranging  from  real-time  embedded  hardware- 
in-the-loop  testing  to  large-scale  Monte  Carlo  simulation  based  parametric  studies.  ROAMS  has  been  successfully 
used  at  JPL  in  several  space  mission-critical  scenarios  for  NASA  across  multiple  domains  (cruise/orbiter,  landers, 
and  rovers).  ROAMS  is  unique  in  its  integrated  approach  to  handling  the  high-fidelity  dynamics,  sensors,  environ¬ 
ment,  control,  and  autonomy  models  that  are  required  for  such  highly  complex  missions  and  are  key  attributes  of 
future  Army  unmanned  ground  vehicles. 


Figure  1 :  HMMWV  UGV  simulator:  The  image  on  the  left  depicts  an  urban  driving  scenario  which  exercises  the 
vehicle’s  autonomous  way-point  and  road  following  software.  The  image  on  the  right  shows  the  same  vehicle  in  an 
off-road  scenario  with  obstacle  avoidance  capability. 


In  this  project  we  have  adapted  the  ROAMS  vehicle  simulation  framework  to  have  the  following  attributes:  the 
model  of  a  common  military  vehicle  (the  HMMWV),  multibody  dynamics  based  on  the  fast  recursive  order-N  spatial 
algebra  formulation,  wheeled  locomotion  capability,  sensor  models  (cameras,  GPS,  radar,  LIDAR)  and  actuators,  off¬ 
road  deformable  terrains  with  vehicle  -  soil  interaction  terramechanics  models,  drive-to-goal  locomotion  planning  with 
obstacle  avoidance,  drive/steer  to  maintain  vehicle  stability  while  following  a  prescribed  path  and  avoiding  obstacles, 
and  3D  real-time  graphics  visualization  and  data  logging  capability  [3].  The  simulator  supports  both  urban  and 
off-road  driving  scenarios  as  illustrated  in  Figure  1. 

In  this  paper  we  will  describe  the  current  status  of  the  UGV  simulator  -  its  capabilities,  performance  benchmark¬ 
ing,  validation  and  evaluation  results.  The  paper  also  provides  an  overview  and  update  on  current  work  to  enable  the 
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modeling  of  semi-autonomous  vehicle  operation  which  includes  integration  of  the  following  items:  a  sophisticated 
autonomous  navigation  algorithm  with  obstacle  avoidance,  a  driver  model  capable  of  simulating  the  input  of  a  human 
teleoperator,  and  a  shared-control  algorithm  capable  of  combining  simulated  human  and  autonomous  inputs. 


2  UGV  Autonomy  Software 

Currently  fielded  Army  unmanned  ground  vehicles  (UGV)  are  operated  remotely  by  humans  who  control  all  actions 
taken  by  the  UGV.  Human  teleoperation  of  UGVs  is  negatively  affected  by  the  effects  of  latency  and  reduced  situa¬ 
tional  awareness,  while  autonomous  algorithms  still  suffer  from  mission-threatening  failure  under  complex  scenarios 
[4-8].  Because  of  these  drawbacks,  the  use  of  shared  control  methods  which  blend  the  strengths  of  both  humans 
and  automation  is  an  area  of  significant  research  interest  to  the  Army  going  forward  [9-11].  The  Army  is  interested 
in  using  modeling  and  simulation  to  enable  evaluation  of  UGV  mobility  across  the  full  range  of  shared  control  options 
from  full  teleoperation  to  full  autonomy  without  having  to  engage  in  expensive  human  testing.  New  capabilities  cur¬ 
rently  being  implemented  into  ROAMS  to  model  shared  control  are  aimed  to  keep  it  at  the  leading  edge  of  simulation 
capabilities. 


Figure  2:  Schematic  of  the  ROAMS  simulation  of  a  semi-autonomous  UGV  adapted  from  reference  [12]. 


A  high-level  block  diagram  of  the  components  necessary  for  a  shared  control  system  is  shown  in  Figure  2. 
While  a  long-term  goal  is  to  eventually  have  a  suite  of  models/algorithms  to  choose  from  for  each  of  the  different 
components,  the  current  effort  involves  integration  of  initial  capabilities  in  each  area.  This  includes  the  following 
items:  an  autonomous  navigation  algorithm  with  obstacle  avoidance,  a  driver  model  capable  of  simulating  the  input 
of  a  human  teleoperator,  and  a  shared-control  algorithm  capable  of  combining  simulated  human  and  autonomous 
inputs  to  model  semi-autonomous  shared  vehicle  control. 

2.1  Autonomous  Navigation  Algorithm 

The  autonomous  navigation  algorithm  being  integrated  into  ROAMS  has  been  developed  at  the  University  of  Michi¬ 
gan  Automotive  Research  Center  (ARC)  with  TARDEC  funding  [13].  A  block  diagram  of  the  algorithm  flow  is  shown 
in  Figure  3.  The  algorithm  uses  LIDAR  as  the  obstacle  detection  sensor,  incorporates  a  multi-stage  Model  Predic¬ 
tive  Control  (MPC)  formulation,  and  is  specifically  designed  to  be  able  to  handle  large  vehicles  such  as  a  HMMWV 
operating  at  high  speeds  (20-60  mph).  It  primarily  seeks  to  minimize  the  travel  time  to  a  desired  destination  location 
while  avoiding  obstacles  and  ensuring  vehicle  safety,  which  in  practice  is  defined  as  avoiding  any  single  wheel  liftoff 
condition.  The  inherent  vehicle  dynamic  limitations  that  could  lead  to  wheel  lift-off  are  incorporated  into  the  algo¬ 
rithm  in  the  form  of  constraints  in  the  optimization  formulation  which  limit  the  maximum  vehicle  speed  and  steering 
angle  control  commands  generated  given  the  current  system  state.  These  constraints  are  pulled  from  pre-computed 
lookup  tables  produced  by  a  high-fidelity  vehicle  dynamics  model,  thus  avoiding  the  need  to  run  such  a  model  in 
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Figure  3:  Block  diagram  of  MPC  autonomous  navigation  algorithm  from  reference  [13]. 


real-time.  The  algorithm  can  also  incorporate  into  the  optimization  known  (or  estimated)  latencies  in  the  vehicle 
sensing  and  control  actuation  systems  and  mitigate  the  negative  effects  of  such  delays  as  long  as  the  LIDAR  has 
sufficient  range. 

2.2  Driver  Model 

The  driver  model  being  integrated  is  a  modified  version  of  a  highway  driver  model  developed  at  Drexel  University 
and  implemented  in  the  ACT-R  cognitive  architecture  [14].  ACT-R  (short  for  Adaptive  Control  of  Thought-Rational) 
is  a  high  level  model  of  human  cognition  embedded  into  a  computational  framework  [15].  The  driver  model  is  a 
specialized  task  model  written  in  the  ACT-R  language  which  simulates  the  sensory/motor  performance  of  a  human 
driver.  At  present  the  driver  model  can  simulate  a  teleoperator  trying  to  follow  a  predefined  path  under  different 
latency  conditions.  It  produces  steering  and  throttle  control  inputs  that  can  be  directly  applied  to  the  vehicle  model. 
Adding  an  interface  to  the  general  ACT-R  architecture  into  ROAMS  as  is  being  done  in  the  current  project  will  allow 
new  cognitive  task  models  to  be  added  in  the  future  which  can  simulate  other  aspects  of  operator  performance. 

2.3  Shared  Control  Algorithm 

The  shared  control  algorithm  being  integrated  was  developed  at  MIT  and  performs  a  proportional  blending  of  the 
control  inputs  provided  by  the  autonomous  algorithm  and  the  human  driver  model  [12],  A  blending  value  k  is  com¬ 
puted  by  the  algorithm  with  k  =  0  representing  pure  teleoperation  where  only  the  operator  control  input  is  applied 
and  k  =  1  representing  pure  autonomous  operation.  The  exact  value  of  k  used  depends  on  the  computation  of 
a  threat  metric  which  is  meant  to  represent  how  close  the  system  is  to  a  mission  ending  failure  (such  as  vehicle 
rollover).  As  the  computed  threat  increases,  so  does  the  value  of  k,  but  the  exact  nature  of  the  k(threat)  function  is 
configurable.  It  can  be  based  on  one  or  more  system  state  variables  and  can  vary  from  a  simple  linear  relationship 
to  more  complicated  monotonically  increasing  functions  depending  on  desired  performance  considerations. 


3  UGV  Dynamics  Model 

An  emphasis  of  this  research  is  to  achieve  close  to  real-time  dynamics  performance  for  allowing  the  closed-loop 
testing  of  unmanned  ground  vehicles  (UGV)  for  urban  as  well  as  off-road  scenarios.  The  overall  vehicle  simulator 
performance  is  governed  by  the  multibody  dynamics  model  for  the  vehicle,  the  wheel/terrain  interaction  dynamics 
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and  the  sensor  models.  Our  modeling  approach  is  tailored  to  support  accurate  dynamics  model  for  ground  vehicles 
with  complex  suspension  dynamics  while  meeting  the  computational  performance  goals. 

The  simulator’s  architecture  allows  the  seamless  selection  of  different  fidelity  levels  and  model  parameters  across 
the  full  modeling  suite,  and  more  importantly,  provides  analysts  with  a  modular  way  to  swap  component  models  for 
changing  vehicle/control/sensor  behavior.  A  critical  aspect  of  our  UGV  simulator  is  its  use  of  the  recently  developed 
constraint  embedding  technique  for  modeling  the  dynamics  of  the  HMMWV  suspension  system  which  consists  of  a 
double  wishbone  suspension  at  each  wheel  of  the  vehicle.  Not  only  does  the  constraint  embedding  approach  reduce 
the  size  of  the  dynamics  model,  but  it  also  leads  to  an  over  lOOx  speed  up  over  conventional  dynamics  modeling 
methods  as  measured  in  benchmark  tests. 

The  UGV  simulation  architecture  represents  a  shift  in  paradigm  by  empowering  analysts  with  full  visibility  and 
control  in  tailoring  key  elements  of  the  simulator.  This  scalable  architecture  allows  the  adaptation  and  tuning  of 
simulation  fidelity  across  a  very  broad  range  (e.g.  rigid/flex-body  dynamics,  sensor  fidelity,  dynamics/kinematics 
modes)  needed  for  the  multi-layered  testing  of  complex  autonomy  behaviors.  The  modular  design  also  allows  the 
insertion  and  closing  the  loop  with  vehicle  autonomy  modules  and  sensor  packages  for  the  evaluation  of  system 
level  performance  and  carrying  out  trade  studies  to  optimize  design  metrics  without  sacrificing  essential  fidelity 
characteristics.  This  feature  is  in  contrast  with  alternative  approaches  that  provide  narrow  capabilities  for  specialized 
aspects  such  as  sensor  fidelity,  vehicle  dynamics,  or  behavioral  models  that  address  only  a  narrow  slice  of  vehicle 
autonomy  simulation  needs.  This  simulation  approach  has  been  successfully  used  by  analysts  across  multiple  NASA 
centers  for  a  variety  of  problems. 

The  details  of  the  vehicle  dynamics  and  sensor  modeling  have  been  described  in  reference  [3]  and  we  provide 
a  brief  overview  here.  We  describe  in  more  detail  our  recent  work  in  extending  the  tire/soil  interaction  models  to 
include  hard/soft  tire  and  terrain  model  dynamics  within  the  UGV  simulator. 

3.1  Vehicle  Modeling 

We  describe  here  the  multibody  dynamics  modeling  approach  for  our  reference  4-wheeled  vehicle,  which  has  a  dou¬ 
ble  wishbone  suspension  and  associated  spring-damper  unit  at  each  wheel  (Figure  4). 
Each  of  these  wheel  suspensions  contains  a  number  of  articulated 
bodies  with  multiple  kinematic  closed  loops.  Due  to  the  constraints, 
each  suspension  has  only  a  single  effective  degree  of  freedom. 

The  standard  approach  for  modeling  closed-chain  system  dy¬ 
namics  [16]  decomposes  the  system  into  a  a  set  of  independent 
bodies,  and  appends  the  closed-chain  bilateral  constraints  to  the 
equations  of  motion.  A  drawback  of  this  absolute  coordinates  ap¬ 
proach  (also  referred  to  as  the  fully  augmented  (FA)  approach)  is 
the  high  computational  cost  for  solving  the  equations  of  motion. 

Another  serious  drawback  is  the  constraint  violation  error  drift  that 
arises  during  the  integration  of  the  multibody  dynamics  equations  of 
motion.  This  error  drift  is  usually  handled  by  the  use  of  a  differential- 
algebraic  equation  (DAE)  solver  and  error  correction  algorithms  to 
manage  the  constraint  error  over  time,  adding  even  more  com¬ 
putational  cost  and  accuracy  error  to  the  dynamics  solution.  Our 
real-time  performance  needs  require  us  to  find  alternative  solutions 
to  overcome  these  major  computational  drawbacks  of  the  conven¬ 
tional  approach. 

Instead  of  the  absolute  coordinates  dynamics  formulation,  we 
use  a  minimal  coordinates  approach  for  the  dynamics  modeling.  One  advantage  of  the  minimal  coordinates  approach 
is  that  the  size  of  the  dynamics  model  is  significantly  smaller.  Moreover,  the  minimal  coordinates  model  allows  us  to 
use  structure-based  low-cost  recursive  dynamics  algorithms  [17]  whose  computational  cost  scales  only  linearly  with 
the  number  of  degrees  of  freedom. 

An  area  that  required  special  attention  was  the  handling  of  the  closed-loop  constraints  within  the  wheel  suspen¬ 
sions  which  are  not  supported  by  the  recursive  dynamics  algorithms.  For  this,  we  turned  to  the  recently  developed 
constrained  embedding  (CE)  techniques  developed  using  the  spatial  operator  algebra  (SOA)  methodology  [17,  18]. 


Figure  4:  The  double  wishbone  suspension  for 
a  single  wheel. 
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The  constraint  embedding  technique  uses  graph  transformation  techniques  to  convert  the  multibody  systems  with 
graph  topologies  into  ones  with  tree  topology,  and  thereby  once  again  allowing  the  direct  use  of  the  O(N)  recursive 
algorithms  for  solving  the  system  dynamics.  The  CE  graph  transformation  process  converts  all  constraint  loops  into 
variable  configuration  compound  bodies  which  have  the  same  number  of  degrees  of  freedom  as  the  number  of  inde¬ 
pendent  degrees  of  freedom  for  the  loops  they  replace.  These  compound  bodies  locally  handle  their  internal  degrees 
of  freedom  and  constraint,  effectively  hiding  them  from  the  dynamics  solver.  Thus  the  resulting  system  topology  is 
once  again  a  tree  with  only  inter-body  hinges  and  no  bilateral  constraints. 

Besides  allowing  the  use  of  the  recursive  O(N)  tree  algorithms,  this  formulation  allows  the  use  of  simpler  ODE 
integrators  instead  of  DAE  integrators.  Moreover  no  additional  error  control  techniques  are  needed.  The  SOA 
methods  allow  us  to  simplify  and  implement  CE  algorithms  and  handle  the  aggregated  bodies  with  configuration 
dependent  geometry.  While  the  CE  method  shares  the  minimal  coordinates  attribute  with  projection  dynamics  tech¬ 
niques  [16,  19],  its  advantage  lies  in  the  preservation  of  the  system’s  tree  topology  structure  that  is  necessary  for 
the  use  of  the  structure-based  recursive  algorithms.  The  CE  approach  for  the  multibody  modeling  of  the  vehicle 
and  suspension  dynamics  is  described  in  detail  in  reference  [20].  Table  3.1  (from  reference  [3])  summarizes  the 
speed  comparison  between  the  FA  and  CE  vehicle  dynamics  solution  methods.  Also  included  in  the  table  is  the  tree 
augmented  (TA)  method  which  also  exploits  recursive  minimal  coordinate  techniques  but  still  has  to  work  with  explicit 
closed-loop  constraints.  The  FA  dynamics  model  is  over  14  times  larger  and  120  times  slower  than  the  CE  model. 


Method 

Number  of  degrees  of  freedom 

Number  of  constraints 

Overall  size 

Simulation  time  ratio 

CE 

15 

0 

15 

1 

TA 

45 

30 

75 

4.1 

FA 

216 

201 

417 

120.0 

Table  1 :  A  comparison  of  the  dynamics  model  size  and  computational  speed  for  the  FA,  TA  and  CE  formulations  for 
the  HMMWV  vehicle. 

The  use  of  advanced  dynamics  techniques  such  as  CE  have  been  critical  to  achieving  the  simulation  performance 
needed  for  our  UGV  testbed.  To  the  best  of  our  knowledge,  this  is  the  first  instance  of  the  application  of  these 
new  techniques  for  modeling  complex  vehicle  system  dynamics  without  sacrificing  dynamics  fidelity.  We  have  made 
considerable  improvements  recently  to  increase  the  CE  algorithm  speed  even  further,  and  the  updated  benchmark 
performance  results  can  be  found  in  reference  [20]. 

3.2  Modeling  rigid  wheel  on  soft  soil 

We  are  using  the  Bekker  approach  for  modeling  the  dynamics  model  of  a  rigid  wheel  interacting  with  soft  soil  [21-23] 
and  provide  a  brief  overview  of  the  model  here.  Bekker’s  relationship  between  static  sinkage  and  normal  stress  is 

<r(H)  =  +k<t>)  Hn  (1) 

where  b  denotes  the  wheel  width.  The  entry  and  exit  angles  (Figure  5)  are  related  to  the  total  sinkage  and  exit 
penetration  as  follows 

0f  =  arccos(1  —  H/Rul)  and  0r  =  arccos(1  —  He/Rui)  (2) 

The  exit  penetration  hr  depends  on  the  elastic  stiffness  Ks  of  the  soil.  The  angle  of  maximum  stress  0m  is 

0-m  =  (do  +  O-i  Si_)0f  (3) 

The  wheel  normal  normal  stress  distribution  cr(0)  is 

^  + 1<4> )  (Rui  (cos(0)  -  cos(0f)))n  for  0m  <  0  <  0f 

+  k<t>)  (Rui  (cos  (0f  -  (9em~-ej)(0f  -9m))  -cos(0f)))  for  0r  <  0  <  0m  ^4/ 
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Figure  5:  Figures  showing  the  geometry  of  wheel  sinkage  (left)  and  stress  distribution  under  the  wheel  (right)  from 
reference  [24], 


With  Tmax(0)  =  c  +  cj(0)  tan(4>).  the  shear  stresses  in  the  longitudinal  direction  tx(0)  and  the  lateral  direction  (0) 
are 


Tx(0)  = 


/  |jX(0)l  \ 

c(0)(1-exp  k*  \  and  ^(0)=^ 


,  liv  (9) 

.(0)  1  —  exp 


where  the  longitudinal  and  lateral  shear  displacements  jx(0)  and  jVJ  (0)  respectively  are  [23] 

jx(0)  =  Rui(0f  -0)  -  ^-(sin(0f)  -sin(0)  and  jy (0)  =  ^-(0f  -  0) 


and  the  longitudinal  and  lateral  shear  modulus  kx  and  ky  respectively  are 


(5) 

(6) 


kx  —  kx0  ~F  kx1  OC,  ky  —  kyo  ~F  kyi  ^  (7) 

The  components  of  the  force  vector  f(0)  =  [fx,  fy ,  fj*  are  given  by 

fx (0 )  =  cos(0)  —  cr(0)  sin(0))  (longitudinal  force) 

fy  (0)  =  R^Ty  (0)  (lateral  force)  (8) 

fz(0)  =  Rui(^x(0)  sin(0)  +  cr(0)  cos(0))  (vertical  load) 


The  overall  force  F  and  moment  M  at  the  wheel  center  are 


F  =  b 


re  f 

eT 


f(0)d0, 


M  =  b 


re  f 

(R(0)  x  f(0))d0 
er 


(9) 


The  components  of  M  are  referred  to  as  the  overturning  moment,  the  rolling  resistance  moment  and  the  aligning 
moment 


3.3  Modeling  soft  tire  on  rigid  terrain 

This  section  presents  the  Fiala  model  for  modeling  the  dynamics  interaction  of  a  deformable  soft  tire  with  rigid  terrain 
such  as  paved  roads.  The  Fiala  tire  model,  developed  by  Fiala  in  1954  is  a  simplified  model  that  does  not  require 
extensive  and  complicated  physical  tests  to  determine  the  necessary  parameters. 

The  normal  force  Fz,  as  shown  in  Figure  6  is: 

Fz  =  max((kt6  +  ct5),  0)  (10) 
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Figure  6:  The  figure  on  the  left  illustrates  the  tire  normal  force  computation  model,  and  the  one  of  the  left  key  wheel 
kinematic  parameters  from  reference  [25]. 


The  maximum  function  ensures  that  the  normal  force  is  zero  when  the  tire  is  not  in  contact  with  the  ground. 

Given  the  longitudinal  speed  vx,  the  tire  loaded  radius  Ri,  and  the  tire  angular  speed  d,  also  shown  in  Figure  6, 
the  tire  longitudinal  deflection  (slip)  SL  is  [26,  27]: 

s  f  1_RfQ  =  1_R7  for  vx  <  Rtd  (driving)  or  Re  <  Rv 
L  1  —  1  =  —  1  for  vx  >  Rid  (braking)  or  Re  >  Ri 

Slip  value  of  0  implies  no  slippage.  The  limiting  value  of  1  corresponds  to  zero  longitudinal  velocity  with  non-zero 
angular  velocity  (i.e.  spinning  in  place),  while  the  limiting  value  of  -1  corresponds  to  zero  angular  velocity  with 
non-zero  longitudinal  velocity  (i.e.  pure  sliding). 

The  transversal  deflection  <x  or  lateral  slip  angle  and  the  lateral  slip  coefficient  S«  are 


Sa  =  tan  (a)  =  — — 
vx 


(12) 


The  comprehensive  slip  ratio  SLa 

Sl«  =  ^S2l  +  S  1  (13) 

The  instantaneous  value  of  the  coefficient  of  friction  \x\s  obtained  by  linear  interpolation  between  |i0  and  pi  using 
SL«  as  follows: 

p  =  Ho-SLcc(p0-pi)  (14) 


The  critical  value  of  longitudinal  slip  ratio  S[  below  which  the  tire  is  in  elastic  deformation  state,  and  beyond  which 
the  tire  is  in  full  longitudinal  sliding: 


S 


*  _ 

L  — 


pFz 

2CS 


(15) 


The  critical  value  of  lateral  slip  angle  a*  below  which  the  tire  is  in  elastic  deformation  state,  and  beyond  which  the 
tire  is  in  full  lateral  sliding  state: 


S«  =  tan  (a*) 


3pTz 

”c7 


(16) 


The  slip  angle  intermediate  parameter  H  which  is  negative  during  full  lateral  slippage  and  non-negative  otherwise: 


H  =  1 


CJScJ 

3p|Fz| 


S 

°  Oi 

s* 

°oc 


(17) 


The  force  and  moment  expressions  for  the  Fiala  tire  model  [28]  are  as  follows.  The  longitudinal  force  (or  drawbar 
pull)  is: 


Fx 


CsSl  for  |SlI  <  Sj[  (elastic  deformation) 

sgn(Si_)  [y^z  —  ^sjjcl )  ^or  ^  Sl  (full  longitudinal  slip) 


(18) 
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The  transverse  force  is: 


Fy  =  sgn(oc) 


— p|Fz|(1  —  H3)  for  |a|  <  a*  (elastic  deformation) 


— p|Fz|  for  |a|  >  a*  (full  lateral  slip) 

The  overturning  moment  is  Mx  =  0.  The  lateral  moment  is 

_  j  — CrFz  for  £2  <  0  (rolling  forwards) 
y  \  CrFz  for  O  >=  0  (rolling  backwards) 

Finally,  the  normal  (aligning)  moment  is: 

M  _  f  2R2p.|Fz|(1  —  H)H3sgn(a)  for  |a|  <  a*  (elastic  deformation) 
z  |  0  for  |a|  >  a*  (full  lateral  slip) 

This  takes  into  account  the  effect  of  the  pneumatic  trail. 


(19) 


(20) 


(21) 


3.4  Modeling  soft  tire  on  soft  soil 

As  illustrated  in  Figure  7,  a  tire  on  soft  soil  incurs  tire  deformation  as  well  as  sinkage.  We  use  the  surrogate  circle 
approach  [24,  29-33]  to  better  approximate  the  tire  contact  surface  with 
the  ground.  The  surrogate  circle  is  assumed  to  pass  through  the  entry 
and  exit  points  of  contact  with  the  terrain,  and  furthermore  be  tangential 
to  the  ground  at  the  exit  point.  The  relationship  of  the  surrogate  circle 
radius  Rs  to  the  Rui,  the  tire  deformation  6  and  sinkage  H  can  be  obtained 
using  the  following  series  of  chord/radius  expressions  from  Figure  7: 


X2  =  5(2Rut  —  6) 

Y2  =  (6  +  h)(2RuV-6-H) 
(X  +  Y)2  =h(2Rs  -h.) 


(22) 


a/H(2Rs  -  h)  =  a/S(2Ru1  -  6)  +  V(5  +  h)(2Rul  -  6  -  h) 


Assuming  that  Rs,  Rui  »  6,  H,  the  above  reduces  to  the  following  simpler 
approximate  relationship  [30] 

'  T 


soil. 


Rui 


(23) 


The  surrogate  circle  radius  Rs  is  used  in  the  Bekker  model  to  compute  the  forces  and  moments  on  the  wheel.  To 
determine  the  6  and  H  values,  The  condition  that  the  normal  load  Fz  from  the  Bekker  model  (using  the  surrogate 
circle  radius)  Eq.  9  should  equal  the  normal  load  from  the  tire  deformation  Eq.  10.  Thus,  given  6  +  H  from  the 
system  kinematic  state,  the  tire  deflection  6  and  soil  sinkage  H  values  are  determined  iteratively  subject  to  satisfying 
the  normal  loads  equality  and  the  supporting  circle  radius  expression  in  Eq.  23. 


4  Results 

The  results  to  date  show  that  the  ROAMS  HMMWV  simulator  can  model  high  fidelity  multibody  dynamics,  terrain, 
sensors,  actuators,  control  and  navigation  algorithms  in  urban  and  off-road  scenarios  at  speeds  that  are  beneficial 
for  autonomous  UGV  analysis  and  design  purposes. 

As  an  example,  a  simulation  of  a  HMMWV  in  a  NATO  double  lane-change  (DLC)  scenario  was  run  using  both 
ROAMS  and  MSC  ADAMS,  a  industry  standard  high-fidelity  modeling  and  simulation  environment.  Figure  8  and 
9  show  the  vehicle  paths  simulated  in  the  two  environments  and  comparisons  of  the  computed  values  for  various 
dynamics  parameters.  The  two  paths  are  not  exactly  identical,  therefore  the  dynamics  results  should  not  be  exact 
matches  but  the  results  represent  a  good  match  in  a  qualitative  sense  as  well  as  in  computed  parameter  magnitude 
as  shown  in  Figure  10. 
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Figure  8:  Vehicle  paths  for  double  lane  change  maneuver,  and  the  roll  angles  and  rates  from  the  ADAMS  and 
ROAMS  simulations. 


Front  Tire  Normal  Force 


Lateral  Acceleration 


Rear  Tire  Normal  Force 


0  1  2  3  4  5  6 

Time  (s) 


Figure  9:  Comparison  of  the  vehicle  lateral  acceleration,  and  the  front  and  rear  tire  normal  forces  from  the  ADAMS 
and  ROAMS  simulations. 


The  ROAMS  and  ADAMS  results  were  generated  on  a  sin¬ 
gle  core  of  an  Intel  Core  17-2600  CPU  at  3.4  GHz.  Even  without 
significant  attempts  to  optimize  performance,  Table  10  shows  that 
ROAMS  on  a  single  core  ran  at  3.4x  real-time  and  was  2.5x  faster 
than  ADAMS  with  comparable  dynamic  fidelity.  The  ROAMS  sim¬ 
ulator  included  vehicle  dynamics  as  well  as  simulations  of  sensors 
such  as  cameras,  lidar  and  GPS  units  while  ADAMS  simulated  only 
the  vehicle  dynamics.  This  demonstrates  that  the  closed-loop  per¬ 
formance  evaluation  and  testing  of  onboard  UGV  autonomy  for  the 
U.S.  Army  vehicles  can  be  carried  out  in  simulation  by  ROAMS  with¬ 
out  having  to  sacrifice  crucial  vehicle  dynamics  fidelity  for  the  sake 
of  performance  speed.  The  performance  of  ROAMS  will  continue 
to  be  improved  based  on  further  optimization. 
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Figure  10:  Simulation  comparison. 


5  Conclusions 

This  paper  provides  an  overview  of  the  ROAMS  UGV  simulator  and  an  update  on  current  work  to  add  new  capabilities 
to  the  software.  These  new  capabilities  include  improved  terramechanics  models  as  well  as  algorithms  for  modeling 
semi-autonomous  control  of  UGVs.  These  enhancements  will  allow  ROAMS  to  help  meet  the  Army’s  UGV  modeling 
and  simulation  needs.  Testing  and  evaluation  have  shown  that  ROAMS  can  provide  closed-loop  simulation  of  UGV 
systems  for  the  Army  without  having  to  sacrifice  crucial  vehicle  dynamics  fidelity  for  the  sake  of  performance  speed. 
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